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(54) FOLLOW-UP DEVICE FOR MANIPULATOR, AND CONTROL THEREOF 
(57)Abstract 

PURPOSE: To achieve high precision follow-up of a work route 
even in high speed work by calculating correction information based 
on a real teaching route when acuated at a desired speed to a 
displayed route, and work feature point positions obtained by 
detected position information from a sensor, and correcting the 
teaching route. 

CONSTITUTION: A sensor 2 moves prior to an effector 1 1 , and a 
work 1 3 is observed in order by commands at a constant cyclic 
period from a sensor controller 5 to detect work route points to be 
sent to a coordinates exchange/ memory part (memory part) 12. 
The memory part 12 converts feature points in a reference 
coordinates system using position information of the feature points 
calculated by the sensor controller 5, and position information of 
the effector 11 obtained based on joint position information 91-6 of 
a manipulator 1 at the time of detection by the sensor 2 to be 
memorized. A correction quantity generating part 6 forms correction 
information based on data in the memory part 12 and a real teaching 
route generated by a real teaching route generating part 1 9 at the 
time of off-line to be outputted to a route correcting part 1 5, which 
then corrects the route. 
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